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(54) MANIPULATOR CONTROL DEVICE 

(57)Abstract: 

PURPOSE: To generate a moving passage of a manipulator at high speed 
by a few memory spaces and a calculating quantity by finding an 
envelope ball obtained by rotating a gripping object with a wrist joint as 
the center, judging the existence of contact with an obstacle when the 
envelope ball moves, and finding a passage in which the envelope ball 
does not contact with the obstacle. 

CONSTITUTION: A passage generating means 1 1 finds an envelope ball 
5 generated when a gripping object 8 rotates with a position of a wrist 
joint 2 as the center, and checks collision with an obstacle 20 when the 
envelope ball 5 is moved by judging that a manipulator 1 grips the 
envelope ball 5, and sets it as a sub-target position by moving an initial 
position to a noninterfering position when the envelope ball 5 and the 
obstacle 20 interfere with each other in the initial position Ps, and finds 
a sub-target position by moving a target position to a noninterfering 
position when the envelope ball 5 the obstacle 20 interfere with each 
other in the target position Pg, and finds a passage 25 in which the 
envelope ball 5 and the obstacle 20 reach the target position Pg from 
the initial position Ps without colliding with each other. 
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